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HuvudfcDcenKosson 
A CONTROL SYSTEM FOR A POWERED VEHICLE 

rsehfilcar ffiRfcf of lAe fnventiofi 

The present bwBnBon relates in a first aspect to a control system fora 

s powered vehicle. 

In a second aspect the present Inventton relates to a nriethod of controIHng 

a movement of a powered vehicle. 

In a third aspect the present invention relates to at least one computer 
program product for controlling a movement of a powered vehicle. 

10 

The theatre has automated much of ttie equipment used for movem^ of 
scenery and lighting. Most of stage activity involves simply moving scenery about 
the ^ge. Automated systems for doing this have been limited by poor radio corn- 
is municatlon. lack of accuracy and navigation, high noise and h^|h costs. 

The document U.S. Patent No. 5.823.884 discloses a powered stage 
wagon comprising a chassis to which there is mounted a pluralRy of rolling support 
means, each of which is located at respective comer of the chassis. The powered 
stage wagon also comprises a firatand a second drive means, bofli mounted on 
20 the chassis In engagement with the suriiace over which the stage wagon is to 
move and are rmilually spaced. The document describes a method of calculating a 
travel path along wwhich the stage wagon may be moved from a current position to 
a desired position. The method coniprising the steps of calculating for each of said 

drive means the bisector of a ane joining the cunent locaflbn of said drive means 
25 and the location of said drive means when the stage wagon has moved to Hs de- 
sired position: determining the point of intersection of the two bisedors; calculating 
tor each of said drive means the tength of an are centred on said point of inter- 
section and passing through both the cunent location of said drive means and the 
location of said drive means when the stage wagon has moved to its desired posi- 
30 «on; controllii^ the rafio of the rotational speeds of flie first and second drive 
means In accordance virtth the ratio of said arc lengths; and controlling the relative 
orientation of said first and second drive means so that each of said drive means 
continuously defines a tangent to the respective are assodated with the drive 
means concerned. 
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One main disadvantage with ttie method of calculating a travel path ac- 
cording to the document US-5.823«884 is that it Ihryts paths to certain predefined 
combinations of translation and rotation. Another disadvantage is that the method 
does not correct fbr any physical errors in movment 0tat might occur. 

5 

Summary of the AirantfoA 

it is an object of the present inveniion to solve the above mentioned prot>- 

lems. 

According to the present irrvention there is prodded in a first aspect a con- 
ic trol system for a powered vehicle fbr describing a desired movement of said vehl- 
de, and communicating said movement to a drive system of said veMcie. The 
powered vehicle comprising a chassis, at least fliree roiling means nnounted on 
said chassis tor engagement with a surface over which said vehl^e is to move. 
The drive system comprises at least two drive units, each comprising a first driwrig 
15 means and a second drh^ng means, co-operatively operable to provide both pro- 
pulsion and steering of said drive unit and consequently said vehicle. The control 
system also comprises a computing means for calcuiatlng a desired movement of 
said vehicle, wherein translation of said vehicle is calculated in said fomi of a con- 
tinuous cubic function , and rotetion of said vehicle is calculated In the form of a 
20 linear function. The control system also comprises a communicating means for 
transmitting said desired movement to said desin^ movement to said at least two 
drive units to move said vehicle in accordance the desired movement One 
advantage with the control system according to the present invention is that it can 
move a vehicle along any predefined patii, witti a predefined change in rotation in 
25 accordance witii a time scale. Anotiier advantage with tiiis control system is tiiat it 
is scalable, i.e. it can move any number of vehicles simultaneously along drflerent 
patiis. Another advantage with this control system is that it allows vehlctes to move 
in any direction. It makes no assumptions as to one direction being more natural 
than another. anotiier advantege with fliis control system is that it uses the 
30 same method of deswibing any type of movement or path. 

A further advantage in his context if said control system also comprises a 
na^^atfon system for determining an actual position of ^d vehicle, whteh a^al 
position is transmitted to said computing means for correcting errors betw^^n the 
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actual position and a desired position accoid ing to raid desired movement of said 
vehicle. 

Furthermore, it is an advantage in this context if said continuous cubic 
lijncllon is a Bezi^ function of a third power. 
5 A further advantage in his context if Bezier function is expressed In accor- 

dance with: 

x - ap^ + bp^ + cp + d 
y =5 ep^ + fp^ + gp + h , 

wherein a-h are constants and p is a variable satisfying 0<p^1. 
10 Furttiermore, it is an advantage in this context if said computing meanis calculates 

said constants a-h according to the foliomng expressions: 

a = xs - 3X2 + 3xi - xo 

e = - 3y2 + 3yi • y© 

b « 3X2 - 6xi + 3xo 
IS f ■ 3y2 - 6yi + 3yo 

c = 3xi - 3xo 

g s 3yi - 3yo 

d B Xo 

h = yo . 

20 wherein pCo. yo) Is a start position and (xa. ya) is an end position of s^ move- 
ment, and (xi , yi) and (X2, y2) are control po«lions of said movement 

Afiirther advantage in his oonlexl if said movmient is made up of at least 
one segment. 

Furthermore* it is an advantage in this conb^ if If saU movement is made 
25 up of at least two s^ments, said control systm has to apply to the following rules 
if said vehicle is to move smoottily from one s^ment to the next 
« a start position of the foiiovnng s^ment murt be the same as an end position of 
the preceding segment; 

- a start rotation ofthefbliovidngsegmem must be the same as an end rotation^ 
30 the preceding segment; 

• a starting path of the following segment must be tangent to an end path of the 
preceding segment; and 

- a starting speed and direction of rotation of the following segment must be the 
same as an end speed and direction of rotafion of flte preceding segment. 
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A further advantage in his context if said compufing means also calculates 
an Instantaneous center of said vehicle. 

Another obj^ of the invention is to provide a nrattiod of controlling, with 
flie aid of a control ^tem, a movement of a powered vehicle. The vehicle com- 
5 pri STO a ch»sis, a drive sys^, at least three rolHng means mounted on said 
chassis for engagement a surface over which said vehicle is to move. The 
drive ^stem comprises at least two drive units, each compri^g a first driving 
means and a second drhring means, co-operafively operable to provide both pro- 
pulsion and steering of said drive unit The method comprises the followins st^: 
10 - with a computing m^ns comprised in said control system, to calculate a 

desired movement of aid vehicle; 

- by calculating a translafion of said vehicle In the form of a conflnuos cu- 
bic funcGon; and 

- by calculating a rotation of said vehicle in the fbmn of a linear function; 

15 and 

- with a communication means comprised in said control s^tem, to trans- 
mit said desired movement to said at least two drive units to move said vehide in 
accordance with said desired movement. One advantage vn\h the method accord- 
ing to tte present invention is that it can move a vehide along any predefined 

20 path, with a predefined change in rotation in accordance widi a time scale. Another 
advantage with this method is that it is scalable, i.e. it can move any number of 
vehicles simuttaneousiy along different paths. Another advantage with this method 
is tfiat ft aRows vehiclas to move in any direction. It makes no assumptions as to 
one dirscSon befr^ more natural than anoitier. Yet another advantage with fliis 
25 method Is that Is uses the same method of describing any type erf movement or 
' f path. 

: Afbrther advantage in this context is achieved if said method also com- 

^ prises the steps ofi 

- vvith a navigation system compraed In said control system, to detennine an ac- 
30 tual position of said vehicle; 

- to transmit said actual position to said computing means; and 

- to correct errors between ^d a^al posHten and a desired position aocondlng 
to said desired movement of sard vehicle. 
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. FSHSteiSTS an advantage in tftia context if said continuouB cubic 
ftrndion a BezI6r fiinclton of a third power. 

AfUrther advantage in fliis context is acltieved if said B©zl6r function is 
expressMi in accordance witii: 
5 X » ap^ + bp* + op + d 
y a ep® + fp* + flP * h . 

wheieln a - h are constants, and p is a variable satisfying 0 s p s 1 . 

Furthermore. His an advantage in this context if said method also com- 
prises tfie steps of 

10 - to calculate said constants a - h acconling to the foilownng expressions: 

a = X3 - 3X2 + 3xi - xo 

e = ys - 3y2 + 3yi - yo 

b = 3X2 - 6xi + 3xo 

f - 3y2 - 6yi + 3yo 
15 c = 3xi - 3xo 

g = 3yi - 3yo 

d = xo 

h " yo . 

wherein pCo. yo) is a etait position and (xs. ys) is an end position of said move- 
20 ment. and wherein (xi . yi) and (X2, ya) are control poslUons of said movement 
A further advantage In tWs context is achieved If said method also com- 
prises the steps dt. 

- to calculate an Instantaneous center and angular velocity of said vehlcte; and 

- to cateulate speeds and angles of said drive unit 

25 Furlhemwre, It is an advantage In this contead If said method also com- 

prises ttie steps oft 

- If said error wiO result In abnipt movement of said vehicle, to Integrate succeed- 

. ing correcfions; and 

- to add a suilable proportion of said oorrectior^ for each time slice. 

30 Another object of the invention is to provide at least one computer pro- 

gram product directly load^le Into the internal memory of at least one digital com- 
puter. The at least one computer program product comprises software code por- 
C- tions for perfbnning the steps of the method according to the present Invention, 

when said at least one product Is/are nm on at least one computer. One advan- 
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tage with tiie computer program product(s) according to flie present Invention is 
that rt/aiey can move a vehicle along any pr^efined path, vwlh a predefined 
change in rotation in accordance with a time scale. Anottier advantage with this 
product is that it is srafable, i.e. it can move any number of vehicles simuitan&- 

5 ously along different paths. Another advantage with this product is tiiat it allows 
vehicles to move in any direcBon. It makes no assumptions as to one direction be- 
ing more natural than another. Yet another advantage with this product is that is 
uses the same method of describing any type of movement or path. 

it should be emphasised that the term "comprises/comprising" when used 

10 in this specification is taken to specify tiie presence of stated features, steps or 
components but does not preclude the presence of one or more other features, in- 
tegers, steps, componertts or groups thereof. 



Brief dftsenpffon of tte drawing 
15 Embodiments of^tKe invention will now be deseed mth a reference to 

the accompan^g drawings, in which: 

F^ure 1 shows a block diagram of a flist embodfmoit of a control systm for 
a powered vehicle according to the present invention; 
Figure 2 shows a side view from above of a drive unit that can be used in 
20 connection with the present invention; 

Figure 3 shows a schematto dtetgram of a powered vehicle fliat can be used In 
connection with the present invention; 

Figure 4 isaflowdiartof a first embodiment of the metiiod of controlling a 
movement of a powered vehicle according to the present invention; arul 
25 F^ure 5 shows a schematic diagram of some computer program products ao* 
cording to the present invention. 

. Detailed description of embodiments 

Figure 1 shows a block diagram of a control system 70 for a powered ve- 
30 hide 72 according to tiie present invention. The powered vehicle 72 comprises a 
drive system (not disclosed* see figure 3). a diassis (not disdosed), at least three 
rolling means (not disdosed) mounted on said d^assis for engagement with a sur- 
face over which said vehlde is to move. The drive system comprises at least two 
drive units (see figure 2), each comprising a first driving means and a second driv- 
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mg meanSl'SSSl^rSSS operable to provide both propulsion and steering of said 
drive units. The control system 70 comprises a computing means 74 tor calculat- 
ing a desired movomenl of said vehicle 72, virtierein translation of said vehicle 72 
Is calculated in the form pf a continuous cubic function, and rotation of said vehicle 

5 72 is calculated in the fiomi of a linear function. The control system 70 also com- 
prises a communication means 76 for transmitting said desired movement to said 
at least two drive units to move said vehicle 72 in accorelance virith the desired 
movement The control system 70 also comprises a navigation system 78 com- 
prised in said vehicle 72 fbr determining an actual position of said vehicle, virhlch 

10 a(*ial position is transmitted to the computing means 74 via saw communication 

means 76 for correcting enors between the actual position and a desired position 
according to said desired movement of said vehlcte 72. 

In a preferred embodiment of the control system 70 according to the pre- 
sent Invention the eontlnuos cubic function Is a Be^ function of a third power. 
15 In a preferred embodiment of the oontrolsystem 70 acconiing the present 

invention the Bezi6r function is expressed In acoonJance with: 
x*ap®+bp*+q» + d 
y«ep*+fp*+gi>+.h, 

wherein a-h are constants and p a variable uftisfying 0 < p < 1 . 
20 in a preferred embodlmenl of the control system 70 according to the pre- 

sent invention the constants a4i are eateulated In accordance wHh ttie fbUovirtr^i 



eo y^-Sys + Syi-yo 
2S b«3)fe-6xi +3xo 

f = 3y2-6yi + 3yo 
c = 3xi Sxo 
g-3yi-3yo 
d = Xo 

30 h = yo 

wherein (xo, y©) is a start position and (ys. ya) is an end posHion of said 
movement, and (xi, yi) and ((j^, ya) are cxmtrol po^'ons of said movement 

In a prefened embodiment of the control system 70 according Id the pre- 
sent invention the movement made m> of at least one segment 
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In a prefened ambodimwit of the control system 70 according to the pre- 
sent invention, tf said movement is made up of at least two segments, the control 
system 70 has to apply the following mles if said vehicle 72 Is to move smoothly 
from one segment to the next: 
5 - a start position of the fbllowwng segment must be the same as an end po- 

sition of the preceding segment; 

- a start rotation of the following segment must be the same as an end ro- 
tation of ttie preceding segment; 

. a starting pafli ofthe following segment must be tangent to an end path 
10 ofthe preceding segment; and 

- a starting speed and direction of ro^on ofthe foBowing segment must 
be the same as an end sped and direction of rotation of the preceding segment 

in a piefened embodiment of the control system 70 according to the pre- 
sent invention, the computing means 74 also calculates an instantaneous center 
15 of said vehicle 72. The movement of any point on the vehicle 72 can always be 
desenlaed as a rotatton about the instanteneous center is calcuiated errors in the 
vehicles position along the cun/e and Ks rotation as reported by the navigation sys- 
tem 78 may be accounted for. 

Figure 2 shows a side view from above of a drive unit 10 which can be 
20 used in connection wtthttie present mvention. 

The drive unit 10 comprises a rolling means 12 intended to be in frictional 
en^gemeitf with a surfiaoe over whid) said drive unit 10 ie intended to move. 
Preferably, said rolling means 12 is a wheel 12. The drive unit 10 also comprises a 
first driving me^is 14, and a second driving means 16, oo-opeiativeiy operable to 
25 provide both pn^ulsion and eteering of said drive unit 10. The first driving means 
' 14 Is arranged on a rotateble support means 1 8 rotatabie about a center axis, c.a. 

The first driving means 14 te operable to rotate said rolling means 12 about a roil- 
ing axis. The rolling a)ds perpendicular to said center axis, ca. As is apparent 
from fig. 2, the rolling means 12 is displaced a predetermined distance from the 
30 center aids, c.a. The second driving means 16 Is operable to rotate the support 

means 1 8 about said center axis, ca. In one prefened embodiment of the drive 
"*: unit 10, which Is disclosed In Hg. 1 . tite first and second driving means 14. 16. 

ea^ is a sen/omotor 14, 16. The drive unit 1 0 also comprises a sprocket means 
20 provided on the drcumfnnence of the support means 18. The sprodtet means 
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20 is driven by the second driving means 16 by way of a transmission means. In 
fho embodtn^nt disclosed in fig. 2, the iiansmis^on means is a cliadn 22 vrinkA\ is 
ei^aged witti said sprocket mrans 20 and a toothed wheel 24 driven by ^dd seo> 
ond dri\dng means 16. The drive unit 10 dlsdosed in fig. 2 also comprises a ten- 
5 sion wheel 26 whidi can lie in engagement with ttte didin 22. The tmsion wheel 
26 can be mov^ aiong a gnxwe 28 so as to aMer the tension on the chain 22. The 
drive unit 10 also con^irtees an inductive sensor 30 arranged in a sensor holder 32 
to delect the position of the sproclcet means 20. Le. the orientation of the wheel 12. 
The drive unit 10 also comprises a rotab'cm limiler 34 arranged in tfie >ridnity of the 

10 sprodcet means 20. Preferab^, the drive unit 10 also comfHises a i^etaiy 
gear-box (not disclosed) mounted on the first driving means 14. and in connection 
the wheel 12. The rotatable support means 18 Is supported by a l>all bearing 
means (not disdosed). The support means 18 is preferably a plate 18. 

Figure 3 shows d schematic diagram of a powered vehicle 50:72 which 

15 can be used in connection with the present invention. 

This vehide 60 comprises two drive units 10, of the same Idnd disclosed In 
fig. 2, and two passive roliing means 52. The two drive units 10 are arranged In 
two diagonally arranged comers of the vehicle and the two passive rolling means 
52 are arrange in ttie two other comers of the vehide. The vehide 50 is e.g. pow- 

20 eted by a battery padc 54. The vehide 50 also comprises a vrireless oommunica- 
tion means 66 for communicating with a remote computer system 58 to control 
said drive unit 10, i.e. the movement and steering of flie vehide SO. The vehicle 50 
^so oominises a laser navigation unit 60, e.g. a laser scanner whidi malces use of 
several reflectors mounted along the perimeter of e.g. the stage area. The vehtole 

2S 50 ateo comprises a central praoesdng unit 62 whidi is connected to file laser 
nav^ation unit 60. the wireless communication means 56, the battieiy pack 54 and 
a number of servo ampHfiers 64 which in turn are oonneded to the drive units 10. 

In figure 4 there is a fkiuvdmrt of a first embodiment of tte method of con- 
trolling a movement of a powered vehide according to the present invantton. The 

30 method begins at block 80. The vehide comprises a diassis, a drive system, at 
least three rdGng means mounted on ^id dis»sis for engagem^ mth a surface 
over which said vehide is to move. The drive ^stem ownprises at least two drive 
units, each comprising a ftst driving means and a seoorKl drivbig means, co- 
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operatively operable to provide both proputslon and steering of said drive units. At 
block 82 the method continues with the step: 

a compuffng means comprised in said controt system, to calculate a 
desired movement of said vehicle. The method continues at blodc 84. to calculate 
5 a translation of said vehicle in fhm form of a oontlnuos cubic funcHon The n&A step, 
at block 86, consists of calculating a rotation of said vehicle in the forni of a linear 
function. 

The metiiod continues at block 88 with ttie step: with a communi^on 
means comprised in flie control system, to transmit saM desired movement to said 
10 at last two dihre units to move said vehicle in accordance vrtUi said desired move- 
ment The method is completed at block 90. 

In a preferred embodiment of the msthod according to tiie present inven- 
tion, the method also comprises the steps oK 

- with a navigation system comprised in saki control systmi. to ctetemnine 
15 an actual position of said vehicle; 

- to transmit said actual position to said computing means; and 

- to correct errors between said actual positfa»i and a desired position ao- 
cording to the desired movement of said vehicle. 

In a preferred embodiment of the mettiod according to the present inven- 
20 tion, the confinuos oibic function is a Bezidr function of a third power 

in a preferred embodiment of ttie method according to tiie present Inven- 
tion, the BeziSr function is expressed in accordance witt): 
X = ap^+ bp^ + cp ♦ d 
y =ep* + 1p^ + gp-f^h. 
25 v^^ein a-h are constants, and p is a variable satisfying 0 < p < 1 : 

In a prefenred eml^iment of the method according to the present inven- 
tion, the method also comprises the st^s of 

to calculate said cons1ar>fs Brh according to tiie following expr^sions: 

aaX3-3X2'*-3Xi-Xb 

30 e = y3-3y2 + 3yi-yo 

b»33^-»&Ci *f 3x6 
f = 3y2-6yi +3yQ 
G«3xt-3xb 
a-3yi-3yo 
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h = yo 

vuhemin (xq, yo) is a start position and 0^. ya) is an end position of ssdd 
movement, and wfieretn (xi, y^) and {Xz, ys) are control positions of said move- 
s ment 

In a preferred «nbodImmt of the metiiod aooonllng to the nieBiod accord- 
ing to the present invention, the method also comprfees the sl^s of. 

- to catculafie an instantaneous center and angular velodty of said vehide; 

and 

10 r to calculate speeds and angles of said drive units. 

In a preferred embodiment of the m^hod according to the present inven- 
tton, the method also comprises the steps of: 

- if said enor wffl result in abrupt movement of ^d vehicte. to in^rate 
succe^ing correcGons; and 

15 'to add a suitable proportion of said oorrectfon for each time slice. 

In figure 5 there is disclosed a schematic diagram of some computer 
program products according to the present invention. There is disclosed n diffeient 
digital computers IOO1. lOOr,. wherein n is an integer. There is also disclosed n 
different computer program products 102i, 102^, here showed In thefomi of 
20 compact discs. The different computer program products 102i 102n are di- 
rectly loadable into the intemal memory of the n different digital computers IOO1, 
.... lOOn. Each computer program product 102i. .... 102n comprises software code 
portions for perfbnning some or all the steps of f^ure 4 when ttie product(s) 102i 
.... 102n is/are run on said computer(s} IOO1 .... lOOn. Said computer program 
25 products 102i I02n can e. g. be In the fbmi of floppy dislcs. RAM disks, mag- 
netic tapes, opto magneticai disks or any other suitable products. 

One advantage with the present invention is that it «in move a vehide or 
robot along any predefined path, with a predefined change In rotation in acoor- 
. dance witti a time scale. 

Another advantage Is that it can move any number of vehicles synchro- 
nously, that is move several vehteles as though they were one, tansparently to the 
user and without any mechanical oonne^on or any cables between the vehld». 

Anoffier advantage Is ttiat it ^lows vehicle to be of any size while using 
the same set of components. 



30 
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Anoth w advantage wifii the present tnvenfion is ttiat it allows the operator 
to control the speed of ttie movements dynamf<»l)y, white the relation positions of 
all vehicles under his/her control remain the same. 

The Invention Is not Omited to the embodiments desorlt)ed in tiie foregoing. 
5 It win t>e obvious that many dlRierent modifications are possible vi^in ttie sci^ of 
the following claims. 
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CLAIMS 

* 

1 . A control system for a powered vehicle for describing a defied niovement 
of saU vehlde, and communteafmg said movement to a drive system df said vehi- 

5 de. wherein said powered v^ide comprteing a chassis, at least three rolOng 
means mounted on said chassis for mgagement with a suri^oe over which said 
vehicle is to move, wherein said drive system comprising at least two drive units 
each comprising a first driving means and a second drfvir^ means, co-operativety 
operable to provide botti propulsion and steerli^ of said drive unit wherein said 

10 control system comprises a computing means for calculating a desired movement 
of said vehicle, wherein translation of said vehicle is calculated in the form of a 
continuous cubic function and rotation of said vehicie is calculated in the form of a 
linear function, v^erein said control system also comprises a communicating 
means for transmitting said desired rnovement to said at least two drive units to 

15 move said vehicle in accordance with the desired movmiant 

2. A control system for a powered vehicle according to Claim 1 , chaiaoterias- 
ed In that said control system also comprises a na^rigation system for determining 
an actual position of said vehicle, which actual position is transmitted to said com- 

20 puting means for correcting errors betw^n tiie actual position and a desired posi- 
tion according to said desired movement of said vehicle. 
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3. A control system for a powered vehicle according to Claim 1 or Claim 2, 
characterized in that said continuous cubic fonctfon £b a Bezi6r fonction of a flnird 

25 power. 

4. A control system for a povmdvehitieaoeofding to 
ed in that said Beas^fiinctkm is ocpressed bi accordance witti: 
X = ap® + bp' + cp + d . 

30 y = ep* + fp* + gp + h , 

vi^iarein a-h are constams and p Is a variable saifsfVing0^p:sl. 



22/01 '02 16:25 FAX 46 8 31 67 fl^ GR01H f « CO •*■ STOCEBOU! iiOlS 

li4LtPatert-ochrepe'^»^ e 31 e? is? 
?nn2 -OV 2 2 i 

HovudfoxsnKosson 

5. A control system for a powered vehicle according to Claim 4. charactertar 
ed In that said computing means caliulates said constants a - h according to the 
following ^qjiessions: 



a 


3 


X3 - 


3X2 + 3X1 - Xo 


5 e 


S 


ys - 


3y2 + 3yi - yo 


b 




3X2 


- 6X1 + 3x0 


f 


as 


3y2 


- 6yi + 3yo 


c 




3x, 


- 3xo 


g 




3yi 


- 3yo 


10 d 




Xo 




h 




yo 


» 
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Wherein (Xo. yo) is a start position and (xa, yj) Is an end posilion of said move- 
ment. and (xi . yi) (X2. y2) are control positions of said movement 

6. A control system Ibr a powered vehicle according to anyone of Claims 1-5. 
charactertased In ttiat said movameht is made up of at least one s^immt 



. 7. A control system for a powered vehldeaccoiding to Claim 6. characterli- 
ed In that, if said movement Is made up of at least two segments, saw control sys- 
20 tem has to apply to the fbUowIng rules if said vehicle is to move smoothly ftom one 
segment to ttie ne9(t: 

- a start posilion of the fonowing segment must be the same as an end position of 
the preceding s^ment; 

- a start rotation of the tbHowing segment must be the same as an end rotation of 

25 the preceding segment 

- a starting path of the following s^ment must be tangent to an end path of the 

preceding s^ment; and 

f a starting speed and direction of.,rotatlon of the following segment must be the 
«tfne as an end speed and direction of rotation of the preceding segment 



30 



8. A control system Ibr a powered vehicle according to anyone of Claims 1-7, 
chaiacferlzed in that said computing means also calculates an instantaneous 
center of said vehide. ! 
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9. Amelhodoff6ontrolflfi9,wtththeakloraG^^ 

powered vehide comprising a chassis, a drive system, at least thiee rolling means 
mounted on said ^ssis for engagement with a suifaoe over which s^d vehide is 
to move, wherein said drive system comprises at least tivo drive units, eac^ com- 
5 prising a first driving means, and a second driving means, oo-opera6vely operable 
to provide t>oth propulsion and steering of said drive unit, wherein said method 
comprises the steps of: 

- with a compufir^ means comprised in said control s^tem, to calculate a de- 
sired nruyvement of said vehide; 

10 - by calcuterting a translation of said vehide in fliefomi of a con^ 
ftindion; and 

* by calwlating a rotation of ^id vehide in the form of a Dn^ function; and 

- with a communicating means comprised in said control system, to transmit said 
desired movement to said at least one drive unit to move said vehicle In accord- 
is ance vwth ssdd desired movement 

10. A method of controlling, vntix the aid of a control system, a movement of a 
powered vehicle according to Claim 9, characterized In that said method also 
comprises the steps of: 

20 - with a navigation system comprised in said control system, to determine an ac- 
tual position of said vehicle; 

- to transmit said actual position to said computing means; and 

- to correct errors between said actual position and a desired position according 
to said drained movement of said vehicle. 



11. A method of controlling, with the aid of a control system, a movement of a 
powered vehicle accofding to Claim 9 or Claim 10, characterizssd In that said con- 
tinuous cubic ftinctton is a Bezi6r function of a third power. 

30 12. A method of controlling, with the aid of a control Systran, a movement of a 
powered vehide aocording to Claim 1 1, eharacierlaed in that said BeaMr function 
is e>qpressed in aoconlarice with: 
X « ap^ + bp^ -I- cp + d 
y > ep^ -I- fp2 -i* gp 4- h , 



25 



02 16:26 FAX 46 8 31 67 GROTH tt CO - P^^^ STOCKHOLM ^017 

Infct Patent- och iig.veit(ef ^ ® 
2002 -01- 2 2 

Huvudfaxen Kassan 

wheiein a-h are constants, and p is a variable satisfying 0^ps1. 

13. A method of controlDng. with the aid of a control system, a movement of a 

powered vehlda acconllng to Claim 12. chaiaelerized in that said method also 

comprises the steps of 
s - to calculate said constants a-h according to the following expressions: 

a = X3 - 3X2 + 3xi - xo 
e = ys - 3y2 + 3yi - yo 
b - 3X2 - 6xi + 3xo 
f = 3y2 - 6yi + 3yo 
10 c = 3xi - 3xo 
g = 3yi-3yo 
d - Xo 
h = Yo , 

wherein pCo, yo) is a start position and (x,, ys) is an end position of said move- 
is ment and wherein (xi . yi) and (xa. ya) are oontrel positions of said movement 

14. A method of contreMng, with the aid of a . control system, a movement of a 

powered vehicle according to anyone of Claims 10-13, ohafaclwlied in that said 

mefliod also ramprises the steps dh 
20 - to cakailalB an InstMitanrous center and angular veiod^ of said vehlde; and 

• to caicutatB speeds and smgles of said drive unit 

15. A method of controlling, with the aid of a control system, a movement of a 
powered vehicle according to anyone of Claims 10-14, eharaderisad in that said 

2S method also comprises the ot 

- If said error will result in abrupt movement of said vehicle, to Integra succeed- 
ing corrections: and 

. to add a euitatrieproporton of said correcHons for each time slice. 

30 16, At least one computer program product (102i 102n) directly loadable 

into the internal memory of at least one digital computer (100i 100,0. com- 
prising software code portions for performing the steps of Claim 9 when said at 

least one product (102i 102,0 te/are run on said at least one computer (lOOi. 

.... 100„). 
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The present invention letates to a control system (70) for a powered vehi- 
de (2) for descnl^ing a desired movement of saM veliicle (72), and communicating 

5 said movment to a drive system of said vehtole (72), The powered vehide com- 
prises a chassis, at least three rolling means mounted on said diassis for en- 
gagement with a surfiace over which said v^ide (71) Is to move. The drive system 
comprises at teast two drive units, each comprising a first dri\rtng means and a 
second driving means, eo-(^»eratively operable to provide both propulsion and 

10 steering of said drive units. The control system (70) comprises a compufing means 
(74) for (^Iculating a desired movement of said vehicle (72), wherein translation of 
said vehicle (72) is calculated In tfie fomi of a confinuos cubic function and rotation 
of said vehicle (72) is calculated in the form of a linear funcBon. The control sys- 
tem (70) also comprises a communicating means (76) fortransmftting said desired 

15 movement to said at least two drive units to move said vehide (72) in accordance 
with the desired movement. 



(Fig. 1) 
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Fig. 4 
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